( MS A -CB- 1828 £7 ) PBECISE CCEIOTEE N88-24213 

CONTE CL LED POSITIONING OF EOBOT END 
i If EC TOES USING FCBCE SENSOES .final fieport, 

1 Jan. 1S67 - 30 Juu. , 1968 ■ (Eccston Univ.) Unclas 

«0 p CSC1 09B G3/63 - .0147455 


Jp/s/uso*f- 

Precise Computer Controlled Positioning 
of Rotot End Effectors Using Force Sensors 
,-L.S. Shieh , B.C. Mclnnis, arid J.C. Wang 

15 June, 1988 ■ . ' :*• 


Final Report for HAG 9-211 




• : ' t - "V?/A/ /-=>' /\ - " v ~ - * 





Department of Electrical Engineering 
Cullen College of Engineering 


University of Houston 





// 

/ 

Precise Computer Controlled Positioning of 
Robot End Effectors Using Force Sensors 



Final Report for Period 1 January, 1987 - 30 June, 1988 
Contract Number: NAG 9-211 


Submitted to: 

NASA-Lyndon B. Johnson Space Center 
Attn: Mr. Charles R. Price 
Mail Code EF2 
Houston, Texas 77058 

Prepared by: 

L.S. Shieh and B.C. Mclnnis 
- - Department of Electrical Engineering ~ 
University of Houston 
Houston, Texas 77004 

J.C. Wang 

College of Engineering 
Idaho State University 
Pocatello, Idaho 83209 


15 June, 1988 


Table of Contents 


Page 


I. Project Summary 1 

II. Objective 2 

III. Work by the Investigators 3 

IV. Discussion 14 

V. References 16 

VI. Table of Figures 17 

VII. Appendix (Additional Research Results) 


37 



I. Project Summary 


A thorough study of the combined position/force control using sensory feedback for a 
one- dimensional manipulator model, which may count for the spacecraft docking problem 
or be extended to the multi-joint robot manipulator problem, has been performed. The 
additional degree of freedom introduced by the compliant force sensor is included in the 
system dynamics in the design of precise position control. State-feedback based on pole 
placement method and with integral control is used to design the position controller. A 
simple constant gain force controller is used as an example to illustrate the dependence 
of the stability and steady-state accuracy of the overall position/force control upon the 
design of the inner position controller. Supportive simulation results are also provided. 
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II. Objective 


The project has the following objective: 

Since automatic control of multidegree-of-freedom robotic manipulators involves high 
order non-linear equations, we propose a pilot project involving the control of a one- 
dimensional system. This simple system can be readily implemented for testing and de- 
velopment of concepts for a computer control system that provides precise positioning of 
an object using force sensor information in a closed-loop. 
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III. Work by the Investigators 


1. Introduction 

A major problem in space application of robotics and the docking of spacecraft is 
the development of technology for automated precise positioning of mating components 
with smooth motion and soft contact [1,2]. A promising approach to this problem involves 
the use of information from force/torque sensors for closed-loop automatic control and a 
significant amount of work [3] has been devoted to the similar problem in robot manipula- 
tors performing environment-interacting tasks such as deburring and assembly operations. 
The basic idea is to use the force feedback, which is generated by the contact between 
the robot and the environment, to modify the motion commands. It has been recognized 
that, from the stability analysis of force control, the force feedback gain is upper-bounded 
by the combined stiffness of the environment and the end effector of the robot [4,5]. To 
improve the performance of robot manipulators in the very stiff environment, mechanically 
compliant wrist sensors may be used; however, the positoning capabilities of the robot are 
then degraded [6]. Thus for the cases when the use of passive compliant mechanisms is 
inevitable, the architecture of position control should be modified to have the position of 
the end effector as the controlled and feedback variable, which may be obtained by utilizing 
the force sensor as also a relative displacement sensor. 

Another important issue of force control is the collision or impact problem [3] which 
arises from the transition between the unconstrained and constrained motion of the robot 
manipulator. This problem may seem to be avoided by making the desired approaching 
velocity (to the environment) of the end effector nearly zero, then motion and force control 
can be handled separately. However, it may be neither feasible because of the imprecise 
environment nor applausable due to its inefficiency in maneuvering. One approach is to 
restructure the controller from path control to force control when the end effector contacts 
the environment. This would require the controller to identify the moment of contact, but 


3 



the short transition period of the impact (e.g. the impulse width of about 0.1 ms of the 
impact force has been reported in [7]) and the inevitable successive bouncing when the 
environment is extremely stiff may render this approach ineffective. An alternative is the 
automatic switching, e.g. a pure velocity damping achieved by force derivative feedback 
may be introduced to smooth the control during impact transition [8]. 

A more general control architecture incorporating the strategy of automatic switch- 
ing is the so-called combined force position control [9] and it is shown in Fig. 1 where 
G represents the position control system including the position controller and the robot 
manipulator, E the stiffness of the environment, S the compliance (l/stiffness) of the ma- 
nipulator, and H the force controller; Xj is the desired position of the robot manipulator, 
e the input command for the position controller, y the position of the manipulator, the 
location of the environment before contact, f c the contact force between the manipulator 
and the environment, and the desired contact force. 

Note that in the mode of unconstrained motion (y < xe), no contact force exists 
(f c — 0) and with zero desired force (/<* = 0), it is a pure position control system; by 
making *<* = and with nonzero desired force (fa j=- 0), it performs as a force control 
system for surface tracing. That the switching between the unconstrained and constrained 
motion for this control architecture is automatic is in the sense that the activeness of the 
force feedback depends on whether the manipulator is in contact with the environment 
and that the monitoring of the moment of contact is not required. 

Since the strategy of automatic switching is utilized, the position controller must 
remain the same for both unconstrained and constrained motion. Therefore, the design 
of the position controller in G must take into account not only the dynamic and accuracy 
requirement of position control but also that of force control because the position controller 
and also G become part of the open-loop system of the complete position/force control loop. 
Thus a proper design of position controller would ease the design of the force controller H 
and enhance the overall system performance. This concept is studied in this report for a 
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one- dimensional manipulator problem. 


2. The One-dimensional Manipulator Model 

Shown in Fig. 2 is the model for a one-dimensional manipulator. A more complex 
robot model including both the rigid body and the first vibratory modes of the arm [10] 
may be used if a more detailed analysis is needed. Since what under study here is the 
dependence of force control upon the deisgn of the inner position controller, similar results 
would be expected. In Fig. 2, m r and c r represent the inertia and damping of the robot 
including the actuator (e.g. a linear motor) and the arm; m 4 , c 4 and fc 4 represent the 
combined mass, damping and stiffness of the force sensor and the end effector (or the 
interfacing element in the spacecraft docking problem), respectively; x r and x 3 measure 
the position of the actuator and the end effector, respectively; Ice is the stiffness of the 
barrier and xe the actual initial distance between the end effector and the barrier; and u 
is the input force (or torque) of the actuator. The state- variable model can be written as 
follows: 


x = Ax -)- Bu + s(xg)DkEXE 

(1) 

rp 

y = x s = C x 

(2) 
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Denote A u = yl| g (.) =0 and A c = -A| a (.) = i, then for the mode of unconstrained motion 


x = A u x + Bu (3) 

y = C T x (4) 

and for the mode of constrained motion 

x = A c x + Bu + DIce^e (5) 

y - C T x (6) 


3. Position Control in Unconstrained Motion 

For the part of position control, the conventional design is to control the position vari- 
able x r of the actuator since it is the measured variable and usually x r = x 8 when a stiff 
force sensor is used. However, for the cases when a compliant force sensor or passive com- 
pliant mechanism is needed, the compliance would introduce additional degrees of freedom 
to the system and the inaccuracy in positioning. Therefore, under such circumstances, 
the position variable of the end effector x a , which may be estimated using the information 

from the force sensor or measured using proximity sensors [-1, 11], should be used as the — . . — 

controlled variable instead. For the consideration of robustness and steady-state accuracy, 
state feedback design based on pole placement method and with integral control [12] is 
adopted here for the position control in the mode of unconstrained motion and is described 
briefly below. 

For the implementation of integral control, an extended state vector z is introduced 

x 

z = = [zj z 2 z 3 z 4 z 5 ] t 

J x a dt _ 

and the corresponding state- variable model becomes 

i = A uz z + B z u 
y = x„ = Cjz 
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The control law is in the form of 

u= J k 5 x*dt — kz (9) 

where x * is the input command to the position controller and 

k = [ki fc 2 k 3 k 4 k s ] T 

Substituting (9) into (7) we obtain the closed-loop transfer function as 

Y(s)/x;{s) = Gp(s) (10) 

= k 5 Cj[aI - ( A uz - B z k)]~ y B z / a 

and the control structure is shown in Fig. 3. Note that the a in the denominator will be 
cancelled out by a zero of Cj\al — ( A uz — B z k)}~ 1 B z at a = 0. 

The control gain vector k is obtained by first choosing the desired closed-loop poles 
and then equating the desired closed-loop polynomial to the characteristic polynomial 
det[sJ — ( A uz — B z k )]. Note that because of the integral control, the DC gain equals one, 
i.e. <?p(0) = 1. 

4. The Complete System in Constrained Motion 

For the mode of constrained motion, the contact between the end effector and the 
barrier produces a contact force / c , which is assumed to be proportional to the displacement 
x » ~ x Ei i- e - fc — — X E )• The system dynamics is described by (5) and (6), and the 

corresponding extended state- variable model is 

z = A cz z + B z u + D z k E x E 
y = x, = Cjz 
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( 11 ) 

( 12 )- 



where 


A c 

: 0 

D z = 

' D ' 

.0 0 1 

0 : 0. 


0 


With the same position controller in the loop, we obtain 

Y{>) = fc s CjV - (A c , - B,k)Y'B,X: {»)/, 
+ Cf|aJ - (A„ - B t k))-'D,k E X B (s) 
= G„(»)jr;(.) + g e ( 3 )A'eW 


where 

Go(-) = fcsCjfs/ - (A C2 - 5 2 fc)]- J 5 z /s 
Ge(») = Cj[s/ - (A cz - B z k)\~'D z k E 


(13) 


(14) 

(15) 


Note again that the a in the denominator of G 0 (s) will be cancelled out by a zero of 
Cj(sl — (A cz — B z k)]~ 1 B z at a = 0. Thus the poles of G 0 (s ) and Ge(j) are the same - 
the eigenvalues of A cz — B z k. The block diagram of the combined position/force control 
is shown in Fig. 4a. Also note that equation (11) can be rewritten as 

z = A uz z -f B z u - D z k E (x s - x E ) (16) 


By combining equations (16) and (12) Y(s) can be expressed as 

Y(s) = k 5 Cj[aI - {A uz - B z k))~ 1 B z X*{s) I s 

+ CJV - {Auz ~ B z fc)]" 1 P,fc JB [X s (i) - Y(s)} 

= G p (s)X*(s) + G' E (s)[X E (s) - Y(a)] (17) 

where 

G' e (s) = Cj[sl - (A uz - B z k)}-' D z k E (18) 

The block diagram for this structure, which is similar to Fig. 1, is shown in Fig. 4b. 
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For the part of force control, it is to design a compensator H(s) for the system having 
the open-loop transfer function fcf:Cx 0 (s). Though theoretically it is possible to design a 
dynamic compensator H(s ) such that the closed-loop system achieves the desired dynamics 
for any given k E G 0 (s), in practice the feasibility of a realizable compensator H(s) depends 
on k£G 0 (s) which in turn is a function of the gain k of the position controller. In other 
words, the choice of k determines not only the system dynamics of position control in the 
mode of unconstrained motion but also the easiness of the design of the force controller 
H(a). This can be illustrated by considering the case of a constant gain force controller 
H{s) = k f . 

First, consider the steady-state performance of the overall position/force system. Note 
that because of the structure of integral control incorporated in the position controller, 
(j o ( 0) = 1 and Ge( 0) = 0 for constant x E and any finite kg if G 0 (s) is stable. Thus 
the steady-state system diagram can be shown as in Fig. 5 if the complete closed-loop is 
stable. By applying the principle of superposition we obtain 

y = {x d +kff d + kEkfXE)/{l + k E kf) (19) 

In the case of pure force control, assume that the end effector is initially in touch 
with the barrier without any contact force. With a nonzero desired contact force f d and 
x d = Xj e, the steady-state contact force is 

fc = k E {y - x E ) 

- kEkff d j{\ + k E kf) (20) 

and the force error is 

e/ = fd ~ fc = /d/(l + k E kf) (21) 

Another case is when we want to position the end effector, which is initially away 
from the barrier, to be barely onto the barrier, i.e. we want to have y = z E and f c = 0. It 
may be argued that this task can be accomplished without any force feedback by choosing 
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Xd — x* s — xe and designing an overdamped position control system, i.e. making the end 
effector approach the barrier without any overshoot. This is not the case in real situations, 
however. The initial actual distance between the end effector and the barrier is ig, but we 
may mistake it as Xd = xe + 8 because of insufficient knowledge or imprecise measurement. 
With such desired position xj and = 0, the steady-state position is 

y = (*E -f 8 + ^e^}Xe)!{ 1 + &£&/) 


= xp +8/(1 -f kpkf) 

(22) 

and the position error and the force error are 


e y = y — xe = 8/(1 + kskf) 

(23) 

fc — kpey = k£8/(l + kpkf) 

(24) 


If Ice — * oo, then y — xe anf f c = 8/kf = u (force generated by the actuator). 

Next, consider the problem of stability. In the mode of constrained motion and without 
force feedback, the system dynamics is characterized by the system function G 0 (s). Though 
G P {s) = G o (s)| fcj5=0 and a well-behaved Gp(a) can be obtained in the design of the position 
controller, however, with nonzero kp the poles of G a (s ) would move away from the pole 
locations of Gp(s ) and with large kp, they may approach the origin and even cross the 
imaginary axis in the s-plane. This would make the stabilization of the overall closed- 
loop system more difficult and even impossible for a constant gain force controller, not to 
mention the increase of the force feedback gain needed to reduce the position and force 
errors. 

Therefore, a compromise must be made in designing the position controller. Not only 
the pole locations of Gp(s) but also those of G 0 (s) for a certain range of kp (depending on 
the environment encountered) need to be considered such that the overall position/force 
loop could have both acceptable system dynamics (appropriate closed-loop pole locations) 
and accuracy (high force feedback gain). For instance, real poles of Gp(«) resulting in fast 
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response may be preferred under the sole consideration of position control, but in some 
cases other choices of poles for Gp(i) might be more justified if the performance of the 
overall system is concerned. 

5. Examples and Simulations 

In the following examples and simulations, it is assumed that m r = 20 Kg, m B — 2 Kg, 
c r = 500 N — sec/m, c, = 5 N — sec/m, and k s = 3000 N/m. To see how the desired 
poles chosen for the position control in unconstrained motion, Gp(s ) in Fig. 3, affect the 
system performance in constrained motion, let’s choose two sets of poles of Gp(s) and 
find the corresponding maximum kfkp which guarantees the stability of the combined 
position /force control loop in Fig. 4. 

Pole set #1: Choose 5 poles for G p (s) as s = —5, —9, —14, —18 and —20; then the 
corresponding five gains fcj for i = 1,2, ...,5 are -356.1,765,1827.1,-1002.5 and 3024. 


kn (N/m) 

Doles of G„(s) 

max kfkp. 

1,000 

-41.4, -10.4 ± j'30.9, —1.9 ± j 1.25 

16 

10,000 

-53.8, -4.92 ± j 77.2, -2.04, -0.346 

185 

100,000 

-60.1, - T.87 ± j226.5, — 2.15, -0.0343 

- 2041 - - ~ 

The root-loci in terms of kfkp for the combined position/force control loop are shown 

in Fig. 6. 



Pole set # 2 : 

Choose 5 poles for G p (s) as s = —2, 

—4, -20, —25 and —30; then the 

corresponding five gains, fc, for i = 1,2,..., 5 are 12276,1065,-10881,-1211.3 and 1600. 

kr. (N/m) 

Doles of 

max kfkn 

1,000 

-46.2, -11.8 ± j28.2, -10.9, -0.255 

79 

10,000 

-58.7, -5.45 ± j'76.5, -11.3, -0.0307 

1981 

100,000 

-65.7, -1.98 ± j226.4, -11.4, -0.00313 

27540 


Similarly, shown in Fig. 7 are the corresponding root-loci for the combined posi- 
tion/force control loop. 
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From the above tables and figures we can see how the stiffness of the barrier, kp, affects 
the root locus of the open-loop system, G c (s), of the combined position/force control. 
Obviously, a more stiff barrier results in an open-loop system with more oscillation. It has 
been shown that the maximum k/kp (guaranteeing the closed-loop system stability of the 
combined position/force control) increases as the stiffness of the barrier, kp, increases. 

One important finding from the comparison of these two tables is that the pole set 
#2, which has a slower response for position control in unconstrained motion, would have 
a much higher maximum kfkp for the stability of the combined position /force control than 
the pole set #1, and thus would have a much better opportunity to reduce the steady-state 
error. 

Some simulations corresponding to the combined position/force control and the pure 
force control will be shown and discussed. In the following simulations, sampling period 
= 10 msec was used, i.e. the control input u was updated every 10 msec. 

(a) Simulations of the combined position/force control: 

Let /a = 0, xg = 0.2 m, x & = 0.202 m with a position deviation of 2 mm. The plots of the 
control input u , the position of the end effector x , , and the contact force f c corresponding 
to each set of poles of Gp(s) chosen before are shown in Fig. 8-12. 

By comparing Fig. 8 and Fig. 9 (kp = 100,000 N/m and kf = 0.02) it can be seen 
that though the response of position control in unconstrained motion is faster in the case 
of pole set #1, it experiences a harder impact and a longer time to settle down after 
the bouncing stops (i.e. the contact force never returns to zero). This observation can 
be confirmed by checking the closed-loop poles of combined position/force control. With 
kf = 0.02, they are s = —62.1, —1.94 ± j 226.4 and —0.021 db jll.9 in the case of pole set 
#1, and s = —66.7, —2.02 ± j'226.4 and —5.13 ± j’6.63 for pole set #2. 

It is interesting to note from Fig. 10 that with kf reduced to 0.002 for the pole set #1 
and kg = 100,000iV/m, while the transient oscillation of low frequency has been improved 
a bit, the contact force f c does increase by 10 times. (From equation (24), if kpkf is large 
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enough, then f c ~ 6/kf.) 

Also note that the bouncing does happen in these simulations because of high stiffness 
of the barrier. The problem of impact and bouncing may be alleviated by adopting a softer 
barrier and this can be clearly seen from the simulation plots shown in Fig. 11 and 12 for 
the pole set #1, kf = 0.02, ks — 10,000N/m and 1,000 7V/m, respectively. 

( b ) Simulations of pure force control: 

In these simulations it was assumed that the end effector was initially at rest on the barrier, 
i.e. Xd = xe = 0. Let the desired contact force fd = 100 N , then the steady-state force 
error will be equal to fd/( 1 + fc/fcjs) ~ 0.05 N. The plots of the simulation results are 
shown in Fig. 13 and 14 for both cases with = lOOflOOiV/m and kf = 0.02. Again, in 
the case of pole set #1 (Fig. 13), it experiences a larger oscillation and a longer settling 
time because of its closed-loop dominant poles (s = —0.021 iy‘11.9) being very close to 
the imaginary axis. 

Shown in Fig. 15 are the simulation plots for the case of pole set #1 with the force 
feedback gain reduced to kf = 0.002. Even with the sacrifice of steady-state error ( = 
fd/( 1 + kfkE) ~ 0.5 N ), the transient response is still inferior to the case of pole set 
#2 with kf = 0.02. This can be confirmed by checking the new closed-loop poles s = 
-60.3,-1.87 ± ji 226.5 and — 0.98 ± y’3.71 with the dominant poles being closer to the 
imaginary axis and having a smaller damping ratio than the case of pole set #2 with 
k f = 0.02. 
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IV. Discussion 


To eliminate completely the steady-state force and position errors, integral action 
may also be included in the force controller H(s). In the case of pure position control, 
i.e. fd = 0, if the end effector stays in contact with the barrier all the time after the 
first impact, then the integral control H(s) would work well; however, if the end effector 
bounces off, then the integral control may produce an undesired equilibrium condition that 
the end effector is not in touch with the barrier, i.e. y — x t < x&. This is because the 
input command to the position controller will be over-adjusted such that x* < xg while 
there is no force feedback in the steady-state. A similar situation could happen as well 
when the given desired position is shorter than the actual distance, i.e. id = a — 6, 
because of imprecise environment. A remedy is to assign a residual force / reg for fd even 
in the position control, which would assure the end effector be in contact with the barrier. 
However, the positioning accuracy may be somewhat sacrificed because the residual force 
fres would adjust the desired position trajectory Xd{t) in the free space. 

In practical applications, the force feedback is obtained by using the measurement of 
the wrist force sensor rather than placing a force sensor at the tip (contact surface) at the 
end effector. It is due to the consideration of the dynamic range of the sensed force, but 
it also introduces errors since the wrist force measurement includes the contact force and 
also the inertia force of the end effector. This inertia force is usually small enough to be 
neglected; if not, a more detailed analysis may be needed. 

For multi-joint robot manipulators, more work and transformation of coordinate are 
needed, especially for the additional degrees of freedom introduced by the compliant force 
sensor, and a systematic robust design similar to [9] may be pursued. For simplicity of 
analysis, all the states are assumed to be available (i.e. no state estimation errors have 
been considered) and the dynamics of the actuator has not been included in this report. 
Taking these factors into consideration, a robustness study may also be required especially 
in the case that the environment is extremely stiff and the problem of impact and bouncing 
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is very critical 
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Fig. 3 The position control in unconstrained motion 
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Fig. 4a The combined position/force control loop 
in constrained motion 



Fig. 4b The combined position/force control loop 
in constrained motion 
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Fig. 5 The steady-state system diagram of the combined position/force loop 
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Fig. 7b - Root locus kf*kE= 0-2000 for case 2, kE=10,000 
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Fig. 8 - Simulation results of combined position/force control 
(Case 1, k =100,000 N/m and k =0.02) 
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Fig. 10 - Simulation results of combined position/force control 
(Case 1, k E =100,000 N/m and =0.002) 
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Fig. 11 - Simulation results of combined position/force control 
(Case 2, k E =10,000 N/m and k f =0.02) 
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Simulation results of pure force control 
(Case 2, k F =100,000 N/m and k f =0.02) 
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Abstract 

A preliminary study of the combined position /force 
control using sensory feedback for a one-diinensiolial 
manipulator model, which may count for the spacecraft 
docking problem or to be extended to the multi-joint 
robot manipulator problem, has been performed. The 
additional degrees of freedom introduced by the com- 
pliant force sensor is included in the system dynamics 
in the design of precise position control. State-feedback 
based on pole placement method and with integral con- 
trol is used to design the position controller. A simple 
constant gain force controller is used as an example to 
illustrate the dependence of the stability and steady- 
state accuracy of the overall position/force control upon 
the design of the inner position controller. Supportive 
simulation results are also provided. 

1. Introduction 

A major problem in space application of robotics 
and the docking of spacecraft is the development of tech- 
nology for automated precise positioning of mating com- 
ponents with smooth motion and soft contact [1,2]. A 
promising approach to this problem involves the use of 
information from force/torque sensors for closed-loop 
automatic control and a significant amount of work (3) 
has been devoted to the similar problem in robot manip- 
ulators performing environment-interacting tasks such 
k: debarring and assembly operations. The basic idea is 
to uae the force feedback, which is generated by the con- 
tact between the robot and the environment, to modify 
the motion commands. It has been recognized that, 
from the stability analysis of force control, the force 
feedback gain is upper-bounded bv the combined stiff- 
ness of the environment and the end effector of the robot 
[4,5]. To improve the performance of robot manipual- 
tors in the very stiff environment, mechanically compli- 
ant wrist sensors may be used; however, the positouing 
capabilities of the robot are then degraded [6j. Thus for 
the cases when the use of passive compliant mechanisms 
is inevitable, the architecture of position control should 
be modified to have the position of the end effector as 
the controlled and feedback variable, which may be ob- 
tained by utilizing the force sensor as also a relative 
displacement sensor. 

Another import ant issue of force control is the colli- 
sion or impact problem [3] which arises from the transi- 
tion between the unconstrained and constrained motion 
of the robot manipulator. This problem may seem to be 
avoided by making the desired approaching velocity (to 
the environment] of the end effector almost zero, then 
motion and force control can be handled separately. Ho- 
ever, it may be neither feasible because of the imprecise 
environment nor applausable due to its inefficiency in 
maneuvering. One approach is to restructure the con- 
troller form path control to force control when the end 
effector contacts the environment. This would require 
the controller to identify the moment of contact, but 
the short transition period of the impact (e.g. the im- 
pulse width of about 0.1 ms of the impact force has been 
reported in [7]), and the inevitable successive bouncing 


when the environment is extremely stiff may render this 
approach ineffective. An alternative is the automatic 
■ witching, e.g. a pure velocity damping achieved by 
force derivative feedback may be introduced to smooth 
the control during impact transition [8], 

A more general control architecture incorporating 
the strategy of automatic switching is the so-called com- 
bined force position control [9] and it is shown in Fig. 1 
where G represents the position control system includ- 
ing the position controller and the robot manipulator, 
E the stiffness of the environment, S the compliance 
(1 /stiffness) of the manipulator, and H the force con- 
troller; Xd is the desired position of the robot manipu- 
lator, e the input command for the position controller, 
y the position of the manipulator, i£ the location of 
the environment before contact, f c the contact force be- 
tween the manipulator and the environment, and fd the 
desired contact force. 

Note that in the mode of unconstrained motion 
(y < *e)) no contact force existB ( f c = 0) and with 
zero desired force (fd = 0), it is a pure position control 
system; by making Xd = xe and with nonzero desired 
force (fd ^ 0), it performs as a force control system 
for surface tracing. That the switching between the un- 
constrained and constrained motion for this control ar- 
chitecture is automatic in the sense that the activeness 
of the force feedback depends on whether the manipu- 
lator is in contact with the environment and that the 
monitoring of the moment of contact is not required. 

Since the strategy of automatic switching is uti- 
lized, the position controller must remain the same for 
both unconstrained and constrained motion. Therefore, 
the design of the position controller in C must take into 
account not only the dynamic and accuracy requirement 
of position control but also that of force control because 
the position controller and also G become part of the 
open-loop system of the complete position/force control 
loop. Thus, a proper design of position controller would 
ease the design of the force controller H and enhance the 
overall system performance. This concept is studied in 
this paper for a one-dimensional manipulator problem. 

3. The One-dimensional Manipulator Model 

Shown in Fig. 2 is the model for a one-dimensional 
manipulator. A more complex robot model including 
both the rigid body and the first vibratory modes of 
the arm [10] may be used if a more detailed analysis is 
needed. Since what under study here is the dependence 
of force control upon the deisgn of the inner position 
controller, similar results would be expected. In Fig. 
2, m T and c r represent the inertia and damping of the 
robot including the actuator (e.g., a linear motor) and 
the arm; m,, c, and k, represent the combined mass, 
damping and stiffness of the force sensor and the end ef- 
fector (or the interfacing element in the spacecraft dock- 
ing problem), respectively; x r and x, measure the posi- 
tion of the actuator end the end effector, respectively; 
kg is the stiffness of the barrier and if the actual initial 
distance between the end effector and the barrier; and 
u is the input force (or torque) of the actuator. 
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The state- variable model can be written as follows: 


The control law is in the form of 


* = Ax + Bu + s(x,)Dk E x, (1) 

y = z a = C T Z (2) 
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Denote A „ = j4|«(.)=o a nd A c = -4 ) = t , then for 
the mode of unconstrained motion 


x = A u x + Bu (3) 

y = C T * (4) 

and for the mode of constrained motion 


where x* is the input command to the position con- 
troller and 

k = |*. k, k , k< k b f 

Substituting (9) into (7) we obtain the closed-loop trans- 
fer function as 

Y{»)IX:{x) = G P (a) (10) 

= k l C'[[al~{A u ,-B,k)]~'B,la 

and the control structure is shown in Fig. 3. Note that 
the s in the denominator will be cancelled out by a zero 
at s = 0 of Cj[al - (A u , - B,k)]~*B,. 

The control gain k is obtained by first choosing the 
desired closed-loop poles and then equating the desired 
closed-loop polynomial to the characteristic polynomial 
detjs/ - (A*, - B,Jk)]. Note that because of the integral 
control, the DC gain equals one, i.e., Gp(0) = 1. 

4. The Complete System in Constrained Motion 
For the mode of constrained motion, the contact 
between the end effector and the barrier produces a 
contact force / c , which is assumed to be proportional 
to the displacement x, — xe, i-e., f c — k E (x, - x E ). 
The system dynamics is described by (5) and (6), and 
the corresponding extended state-variable model is 


x = A c x + Bu -f Dk E x E (5) 

y = C T x (6) 

3. Position Control in Unconstrained Motion 
For the part of position control, the conventional 
design is to control the position variable x r of the ac- 
tuator since it is the measured variable and usually 
z T = x, when a stiff force sensor is used. However, for 
the cases when a compliant force sensor or passive com- 
pliant mechanism is needed, the compliance would in- 
troduce additional degrees of freedom to the system and 
the inaccuracy in positioning. Therefore, under such 
circumstances, the position variable of the end effector 
x,, which may be estimated using the information from 
the force sensor or measured using proximity sensors [1, 
11], should be used as the controlled variable instead. 
For the consideration of robustness and steady-state ac- 
curacy, state feedback design based on pole placement 
method and with integral control (12] is adopted here 
for the position control in the mode of unconstrained 
motion and is described briefly below. 

For the implementation of integral control, an ex- 
tended state vector z is introduced 


x 

J x.di J 


= 1*1 *2 *3 *« *s) 


2 — A cm Z + B,u -f D,k E x E 



where 
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C* 



0 1 
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(H) 

( 12 ) 


With the same position controller in the loop, we obtain 

Y(») = fcsC.V - ( A c , - B t k))-'B.X ;(*)/* 

+ Cj(al - (A,, - B,k)}-'D>k E X E {,) 

= C 0 (a)A';(») + Cs(.)A’ e (,) (13) 


Note again that the a in the denominator in the first 
part of (13) will be cancelled out by a zero at a = 0 of 
Cj\al — (A c , — Hjfc)] -5 B,. Thus the poles of G c (a) and 
G e (i) are the same - the eigenvalues of A c , - B,k. The 
block diagram of the combined position/force control is 
shown in Fig. 4. 

For the part of force control, it is to design a com- 
pensator H(s) for the given open-loop transfer function 


k E G B (a) = t£k 5 C,V - (A c , - B,k)]~ i B,/s (14) 


and the corresponding state- variable model becomes 

i = Ac,z + B,u (7) 

y = x, = Cj z (R) 

where 
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Though theoretically it is possible to design a dy- 
namic compensator U(a) such that the closed-loop sys- 
tem achieves the desired dynamics for any given k E 
G c (a), in practice the feasibility of a realizable com- 
pensator H(a) depends on k E G 0 (a'j which in turn is a 
function of the gain k of the position controller. This 
is to say that, the choice of k determines not only the 
system dynamics of position control in the mode of un- 
constrained motion but also the easiness of the design 
of the force controller B(a). This can be illustrated by 
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contidering the case of a constant gain force controller 
H(s) = kj. 

First, consider the steady-state performance of the 
overall position/force system. Note that because of the 
structure of integral control incorporated in the position 
controller, G 0 ( 0) = 1 and G E { 0) = 0 for constant zb 
and any finite Ice if G 0 (>) is stable. Thus the steady- 
state system diagram can be shown as in Fig. 5 if the 
complete closed-loop is stable. By applying the princi- 
ple of superposition we obtain 


of Gp(i) but alto those of G a (a) tor a certain range of k E 
(depending on the environment encountered), need to 
be considered such that the overall position/force loop 
could have both acceptable system dynamics (appropri- 
ate closed-loop pole locations) and accuracy (high force 
feedback gain). For instance, real poles of Gp(s) re- 
sulting in fast response may be preferred based on the 
sole consideration of position control, but in some cases 
other choices of poles for Gp(») might be more justified 
if the performance of the overall system is concerned. 


V = ( x d + kjfi + k E kjx E )/(l + k E kj) (15) 

In the case of pure force control, assume that the 
end effector is initially in touch with the barrier without 
any contact force. With a nonzero desired contact force 
}i and letting xj = x E , the steady-state contact force 

is 


A = My - x e ) 

= k E k/f d /( 1 + k E kj) (16) 

and the force error is 

*/ = Id ~ fc = fd/(l + k E kj) (17) 

Another case is when we want to position the end 
effector, which is initially away from the barrier, to be 
barely onto the barrier, i.e., we want to have y = t E 
and f c = 0. It may be argued that this task can be 
accomplished without any force feedback by choosing 
x d = x \ — x e an d designing an overdamped position 
control system i.e., making the end effector approach 
the barrier without any overshoot. This is not the case 
in real situations, however. The initial actual distance 
between the end effector and the barrier is x E , but we 
may mistake it as Xj = x E + t because of insufficient 
knowledge or imprecise measurement. With such de- 
sired position Xi and ft — 0, the steady-state position 
is 


V = (*e + 6 + 1c e^i x e)/[I + k E kj) 

— X E + ^/(l d" k E kj) (18) 

and the position error and the force error are 

= y - X E = ^/(l + M/) (19) 

fc = k E e y = k E S/(l + k E kj) (20) 


If k E — oo, then y = x E anf f c — S/kj = u (force 
generated by the actuator). 

Next, consider the problem of stability. In the 
mode of constrained motion and without force feed- 
back, the system dynamics is characterized by the sys- 
tem function G 0 (s). Though Gf(j) = C o (s)| tl=0 and a 
well-behaved G p(i) can be obtained in the design of the 
position controller, however, witli nonzero k E , the poles 
of G 0 (s) would move away from the pole locations of 
Gp(») and with large k E , they may approach the origin 
and even cross the imaginary axis in the s-plane. This 
would make the stabilization of the overall closed-loop 
system more difficult and even impossible for a constant 
gain force controller, not to mention the increase of the 
force feedback gain needed to reduce the position and 
force errors. 

Therefore, a compromise must be made in design- 
ing the position controller. Not only the pole locations 


5. Examples and Simulations 

In the following examples and simulations, let m r = 
20 Kg, m, = 2 Kg, e T = 500 N — tec/m, c, = 5 TV — 
see/m, and k , — 3000 N jm. To see how the desired 
poles chosen for the position control in unconstrained 
motion, Gp(s) in Fig. 3, affect the system performance 
in constrained motion, let’s choose two sets of poles 
of Gp(i) and find the corresponding maximum kjk E 
which guarantees the stability of the combined posi- 
tion/force control loop in Fig. 4. 

Pole set #1: Choose 5 poles for G p (s) as a = -5, -9, 
— 14, —18 and —20; then, the corresponding five gains fc; 
for t = 1,2,. ..,5 are -356.1,765,1827.1,-1002.5 and 
3024. 


kg (A r /m) pole* of G,(») 

1 . 000 -41 .4, - 10 4 ± > 30.8, -Hi >1 .25 

10. 000 —53.8, —4.82 i >77.2, -2.04, -0.348 

100.000 — 60.1, —1.87 i >226.5, —2.15, —0.0343 


mu k/kg 


16 

IBS 

2041 


Pole set #2: Choose 5 poles for G p (s) as a — —2, —4, 
—20, -25 and —30; then the corresponding five gains, 
for i = 1,2,... ,5 are 12276,1065,-10881,-1211.3 
and 1600. 


k c (A7/m) poles of G.(*) 

1.000 -46.2,-11.8 ± j28.2, -10.8, -0.255 

10. 000 -5B.7, -5.45 ± >76.5, - 1 1.3. -0.0307 

100. 000 -85.7, - 1.88 ± >226.4, -11.4, -0.00313 


mu kfk E 
78 
1981 
27540 


From the above table, we can see bow the stiffness 
of the barrier, k E , affects the root locus of the open-loop 
system, G 0 (s), of the combined position/force control. 
Obviously, a more stiff barrier results in an open-loop 
system with more oscillation. It has been shown that 
the maximum kjk E (guaranteeing the closed-loop sys- 
tem stability of the combined position /force control) in- 
creases as the stiffness of the barrier, k E , increases. 

One important finding from the comparison of these 
two tables is that the pole set #2, which has a slower 
response for position control in unconstrained motion, 
would have a much higher maximum kjk E for the stabil- 
ity of the combined position/force control than : .he pole 
set #1, and thus would have a much better opportunity 
to reduce the steady-state error. 

Some simulations corresponding to the combined 
position/force control and the pure force control will 
be shown and discussed. In the following simulations, 
k E = 100,000 7V/m and kj = 0.02 were chosen and 
sampling period = 10 msec was used, i.e., the control 
input u was updated every 10 msec. 

Simulations of the combined position/force control: 

Let fd = 0, z E = 0.2 m, xj = 0.202 m with a position 
deviation of 2 mm. Since kjk E = 2000, the steady-state 
error will be equal to (*j-*e)/(1 + kjk E ) ~ 0.001 mm. 
The plots of the control input u, the position of the end 
effector, x„ and the contact force L corresponding to 
each set of poles of Gpfs) chosen before (set #1: dashed 
line; set #2: solid line) are shown in Fig. 6. 
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It can be teen that though the response of position 
control in unconstrained motion is faster in the case 
of pole set #1, it experiences a harder impact and a 
longer time to settle down after bouncing stops (i.e., the 
contact force never returns to sero). This observation 
can be confirmed by checking the closed-loop poles of 
combined position/force control. With kj = 0.02, they 
are * — —62.1, — 1.94 ± j 226.4 and -0.021 ± jl 1 .9 in the 
case of pole set #1, and t = -66.7, -2.02 ± j'226.4 and 

— 5.13 ± j6.63 for pole set #2. Also note that bouncing 
does happen in both cases because of high stiffness of 
the barrier. 

Simulations of pure force control: 

In these simulations it was assumed that the end effector 
was initially at rest onto the barrier, i.e., = xe = 0. 

Let the desired contact force — 100 N, then the 
steady-state force error will be equal to equal to fd/(1 + 
kjkE) ~ 0.05 N. The plots of the simulation results are 
shown in Fig. 7 for both cases (pole set #1: dashed 
line; pole set #2: solid line). Again, in the case of pole 
set #1, it experiences a larger oscillation and a longer 
settling time because of its closed-loop dominant poles 
(i = —0.021 ± jll.9) being very close to the imaginary 
axis. 

Other simulations (not shown here) have also been 
done for the case of pole set #1 with the force feedback 
gain reduced to kj = 0.002. Even with the sacrifice 
of steady-state error (= fd/( 1 + fc/fcs) ~ 0.5 TV), the 
transient response is still inferior to the case of pole set 
#2 with k/ = 0.02. This can be confirmed by checking 
the new closed-looD poles » = —60.3, —1 .87 ± j 226.5 ana 

— 0.98 ± j'3.71 with the dominant poles being closer to 
the imaginary axis and having a smaller damping ratio 
than the case of pole set #2 with kj = 0.02. 

6. Discussion 

To eliminate completely the steady-state force and 
position errors, integral action may also be included in 
the force controller H(s). In the case of pure position 
control, i.e., Jd = 0, if the end effector stays in contact 
with the barrier all the time after the first impact, then 
the integral control H(a) would work well; however, if 
the end effector bounces off, then the integral control 
may produce an undesired equilibrium condition that 
the end effector is not in touch with the barrier, i.e., 
y = x, < x £. This is because the input command to 
the position controller will be over-adjusted 6uch that 
x“ < X£ while there is no force feedback in the steady- 
state. A similar situation could happen as well when 
the given desired position is shorter than the actual dis- 
tance, i.e., Xi = xe — 6, because of imprecise environ- 
ment. A remedy is to assign a residual force f rc , for fd 
even in the position control, which would assure the end 
effector be in contact with the barrier. However, the po- 
sitioning accuracy may be somewhat sacrificed because 
the residual force frr. would adjust the desired position 
trajectory Xd(t) even in the free space. 

In practical applications, the force feedback is ob- 
tained by using the measurement of the wrist force sen- 
sor rather than placing a force sensor at the tip (contact 
surface) at the end effector, it is due to the considera- 
tion of the dynamic range of the sensed force, but it also 
introduces errors since the wrist force measurement in- 
cludes the contact force and also the inertia force of the 
end effector. Usually, this inertia force is small enough 
to be neglected; if not, a more detailed analysis may be 
needed. 

For multi-joint robot manipulators, more work and 
transformation of coordinate are needed, especially for 
the additional degrees of freedom inloduced by the com- 


pliant force sensor, and a systematic robust design simi- 
lar to [9) may be pursued. For simplicity of analysis, ail 
the states are assumed to be available (i.e., no state es- 
timation errors have been considered) and the dynamics 
of the actuator has not been included in this paper. Tak- 
ing these factors into consideration, a robustness study 
may also be required especially in the case that the en- 
vironment is extremely stiff and the problem of impact 
and bouncing is very critical. 

7. Conclusion 

The combined position /force control using sensory 
feedback for one dimensional manipulator has been stud- 
ied. It is concluded that a tradeoff must be made be- 
tween the position control in unconstrained motion and 
the force control in constrained motion, and the pas- 
sive compliant mechanisms like force sensors and mat- 
ing components should be used whenever possible if the 
problem of impact and bouncing is to be avoided. 
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Fig. 6 Simulation results of combined position/force 
control (dashed line: pole set #1, solid line: 
pole set #2) 
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Fig. 7 Simulation results of pure force control (dashed 
line: pole set #1, solid line: pole set #2) 






